#include "rod_motor.h"

#include <stm32f1xx_hal.h>
#include "gpio.h"

#define OUT1_PORT   ROD_MOTOR_OUT1_GPIO_Port
#define OUT2_PORT   ROD_MOTOR_OUT2_GPIO_Port

#define OUT1_PIN    ROD_MOTOR_OUT1_Pin
#define OUT2_PIN    ROD_MOTOR_OUT2_Pin

void ROD_MOTOR_Stretch() {
    HAL_GPIO_WritePin(OUT1_PORT, OUT1_PIN, GPIO_PIN_SET);
    HAL_GPIO_WritePin(OUT2_PORT, OUT2_PIN, GPIO_PIN_RESET);
}

void ROD_MOTOR_Shrink() {
    HAL_GPIO_WritePin(OUT1_PORT, OUT1_PIN, GPIO_PIN_RESET);
    HAL_GPIO_WritePin(OUT2_PORT, OUT2_PIN, GPIO_PIN_SET);
}

void ROD_MOTOR_Stop() {
    HAL_GPIO_WritePin(OUT1_PORT, OUT1_PIN, GPIO_PIN_SET);
    HAL_GPIO_WritePin(OUT2_PORT, OUT2_PIN, GPIO_PIN_SET);
}